// #include "aim_energy/WindMill.hpp"

// namespace WINDMILL
// {
//     bool windMill::FindHitPoint(cv::Mat &img)
//     {

//         if (GetContours(img))
//         {
//             hit_point = armors[0].center;
//             now_angle = CalAngle(hit_point, center);
//             dangle_deg = ((now_angle - last_angle) / (now_t - last_t));
//             dangle_rad = dangle_deg * Pi / 180;
//             if (abs(dangle_rad) < 8 && mode == big_buff && cnt > 8 && abs(dangle_rad-last_dangle_rad)<2.5)
//             {
//                 anglevelocity_rad.push_back(dangle_rad);
//                 time.push_back(now_t);
//                 // std::cout << dangle_rad << "," << now_t << std::endl;
//                 if (anglevelocity_rad.size() > 60 && time.size() > 60)
//                 {
//                     anglevelocity_rad.pop_front();
//                     time.pop_front();
//                 }
//             }
//             last_angle = now_angle;
//             last_dangle_rad = dangle_rad;
//             return true;
//         }
//         else
//         {
//             return false;
//         }
//     }

// }
